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The desire to design, build, and operate a lightweight, 
long-reach manipulator for NASA space shuttle usage was a 
prime impetus for generating interest in the flexibility 
Pers of robotic arms [Ref. l: pp. 3, 9]. Interest in 
ISO ving productivity in automated manufacturing plants 
through increased speed and accuracy have additionally 
j J a desire to further investigate flexibility effects 
in mechanical devices [Ref. 2: pp. 1, 2]. The design, 
construction, and operation of a flexible robotic manipulator 
arm has many attractive features. In the past the manipulator 
Was assumed being composed of rigid links and dictated that 
the link design be large members, both in cross-sectional 
area and weight. The flexible arm would require minimal 
material and consequently would have less weight and bulk 
than conventional rigid-arm robots. With a smaller, lighter 
weight manipulator, less power would be needed to move the 
arm which could mean use of smaller actuators. Arm speed 
movement would increase if the actuator size is not reduced. 
A smaller, lighter weight manipulator would require less 
foundation mounting strength and rigidity requirements. The 
reduced foundation mounting requirements coupled to the less 
material required for the arm construction would translate 


to a lower overall cost to build a flexible-arm robot compared 


to a rigid-arm robot. The reduced mass of the flexible-arm 
robot would cause less damage if inadvertent collision 
occurred and would be consequently safer to operate compared 
to a rigid-arm robot. Finally, the reduced weight of the 
flexible-arm robot would allow for easy transportability 
[Ref. 3: p'un 5 na 

The preceding discussion of the advantages of utilizing 
flexible-arm robots points to their tremendous potential for 
application in industry, in the military, and in space. Іп 
spite of these advantages for utilizing flexible-arm robots, 
until recently there has been a reluctance to investigate 
the design and control of flexible manipulator arms. One 
reason for this reluctance is the degradation of the end- 
effector positioning accuracy due to the increased deformation 
of the lightweight, flexible arm. Also, the increased vibra- 
tion of the flexible arm causes a significant control problem 
when coupled with the large-scale translational and/or 
rotational motion of the robot [Ref. 3: p. 1209]. This conu 
problem arises due to the reduced bandwidth of the flexible 
manipulator system and the consequent limitation on values of 
gain in the control design. The reduced bandwidth is the 
result of the lower fundamental frequency inherent in a 
flexible manipulator system compared to a rigid system. In 
order to benefit from the advantages of lightweight,flexible 
manipulators it is necessary to implement a control design 
capable of achieving end-effector positioning accuracy and 
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Extensive research began in the early 1980's into the 
design and control aspects of a flexible manipulator arm. 
Information on the dynamic response and the natural frequen- 
cies of the flexible manipulator arm is useful to the designer 
in predicting deformations and stress levels. An accurate 
dynamic model including flexibility allows for simulation 
studies by the designer enabling him to extract his required 
information. An accurate dynamic model including flexibility 
is also necessary for any controller design which is to sub- 
sequently control a flexible manipulator [Ref. 2: pp. 2, 3]. 
An integral, essential part of improving the accuracy and 
stability problems associated with flexible manipulator arms 
is, therefore, the development of an accurate, dynamic model 
of the flexible arm. There are several approaches to the 
development of a flexible structure dynamic model in the 
literature, some of which are reviewed below. 

Until recently, the approach to modeling robotic mecha- 
nisms assumed a rigid structure. The motion consequently 
described by these models included only the large, rigid- 
body motion, hereafter referred to as large motion. The 
recent approach in the development of a dynamic model for 
robotic mechanisms is to include the small motion deforma- 
tions arising from the flexibility of the structure, 
hereafter referred to as small motion. These small motion 


deformations include bending, twisting, and axial extending. 


Sunada and Dubowsky [Ref. 4] utilized the 4x4 transforma- 
tion matrices including the effects of flexibility to describe 
the kinematics of flexible arm motion, specifically applied to 
industrial robots. The small motion deformations were super- 
imposed on an assumed nominal large motion to include the 
effects of flexibility. This model ignored, however, the 
effect of the small motion interaction on the large motion, 
and consequently did not give a complete description of the 
actual motion dynamics.  Sunada and Dubowsky utilized finite 
element method techniques and a method to discretize the 
distributed motion known as Component Mode Synthesis to 
obtain linear, ordinary, differential equations of motion. 

Book [Refs. 5, 6] similarly included the small motion 
deformations in the 4x4 transformation matrices but he 
utilized a modal approach to model the flexible kinematics 
and truncated the series of assumed vibration modes. After 
application of Lagrange's equation and utilizing a combined 
set of large and small motion hybrid coordinates, a complica- 
ted set of dynamic equations of motion were obtained. The 
resulting equations of motion were non-linear in both large 
and small motion variables and were consequently time- 
consuming and expensive to solve. 

Cannon and Schmitz [Ref. 7] utilized a similar modal 
approach with a Lagrangian formulation to model a single- 
link flexible arm. This particular model was obviously very 


restrictive in its application to robotic mechanisms. Cannon 
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and Hollars [Ref. 8] are investigating the modeling and 
control of two-link manipulators with flexible tendons, 
but it appears that the resultant dynamic model is likewise 
restrictive to this special application. 

Truckenbrodt [Ref. 9] modeled the flexible manipulator 
EE cUsvbprrdemuPtibody system consisting of both rigid 
and flexible elements. The application of his model was ы 
a Specialized example and compatibility between links was 
not clearly shown. 

Huston [Ref. 10] developed the dynamic equations of 
Deemon Lor a ilexible, multi-link manipulator utilizing 
a combination Newton-Euler approach and d'Alembert's 
principle. His assumption of a nominal large motion on 
which to apply the small motion deformations was similar 
to Dubowsky's and results in an incomplete representation 
of the actual motion dynamics. 

Chang [Ref. 2] introduced an Equivalent Rigid Link 
System (ERLS) to describe the large motion kinematics. 
The small motion deformations were described relative to 
the Equivalent Rigid Link System. Applying finite element 
techniques and Lagrangian dynamics, two sets of coupled, 
non-linear, ordinary differential equations of motion were 
obtained. Because of the use of the ERLS, these sets of 
equations were composed of one set for large motions and one 
set for small motions. The set of large motion equations 


were non-linear in both the large and small motion variables. 
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The set of small motion equations were linear in the small 
motion variable and non-linear in the large motion variable. 
These particular characteristics of the resultant sets of 
equations of motion allowed for their relatively easy solution 
by a technique developed by Chang known as the Sequential 
Integration Method. Chang's model offered a complete repre- 
sentation of the dynamics of flexible manipulators as well 
as one that could be efficiently solved using the Sequential 
Integration Method. 

The purpose of this research is to experimentally validate 
the accuracy of a dynamic model including £Pexibitity.s ae 
dynamic model chosen is that developed by Chang. This model 
1s tailored to a single-link flexible arm that was designed, 
constructed, and operated for the purpose of the dynamic 
model validation. Hydraulic actuation of the singles aa. 
arm is utilized and the motion of the arm is limited to a 
vertical plane. Computer simulation of the experimental 
flexible arm using the adapted dynamic model is on the IBM 
3033. The integration methods from the Continuous System 
Modeling Program (CSMP) are utilized in the solutions of the 
dynamic equations of motion. Techniques for the acquisition 
of position data of the moving experimental arm are reviewed 
in a subsequent chapter. Photography and strain gauge 
measurement prove to be the most economical and simple 


procedures in this application. 
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The remainder of this thesis includes a chapter on the 
theoretical approach to model the dynamics of the flexible 
manipulator using the Equivalent Rigid Link System (ELRS). 

The Theoretical Approach chapter also includes a discussion 
on the modelling of the hydraulic actuation dynamics and a 
discussion of the computer simulation of the entire flexible 
manipulator system. 

A chapter is devoted to a description of the experimental 
approach utilized in validating the dynamic simulation results. 
The chapter reviews the design of the experimental manipulator 
System, including the hydraulic actuation and the flexible arm. 
The Experimental Approach chapter also reviews various tech- 
niques investigated for experimentally determining the end- 
point position of the flexible manipulator. 

The Results chapter follows and presents a comparison of 
the arm-tip position data obtained during the experimentation 
to the arm-tip position data obtained from the computer 
simulation. Also, a comparison is made between the actual 
strain of the experimental arm and the strain predicted by 
the ERLS dynamic model. 

Der devoted to the control of flexible manipulators 
is included to provide a brief literature review on this 
aspect of flexible manipulator research. Additionally, an 
initial attempt at controlling the single-link flexible 


manipulator using the ERLS model is discussed. 
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Finally, a chapter each is devoted to drawing conclusions 
on the lessons learned in this research effort and for making 
recommendations on the future direction of research in 


flexible manipulators. 
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EI. SRSEOREIICAEFAPPROACH 


Chang's dynamic model is based on his introduction of an 
Equivalent Rigid Link System (ERLS) to describe the large 
rigid motion of the flexible manipulator system. The small 
motion deformations are described relative to the ERLS. The 
local coordinate system for each link is defined in the ERLS 
and deformations are measured relative to this coordinate 
System. Coordinate transformation utilizing joint variables 
of the ERLS is applied to the actual deformed position at any 
Arona link to obtain the absolute position of that point. 
Time derivatives of the absolute positions are necessary for 
the kinetic energy derivation for use in Lagrange's equations. 

It is necessary to discretize the deformations since 
these displacements are for each point along the flexible 
arm. The Finite Element Method (FEM) is utilized to accom- 
plish this discretization of the deformations. The FEM nodal 
displacements represent the small motion deformations at the 
end of the link. A cubic shape function is assumed for each 
beam element. Choice of a cubic shape function ensures the 
complete representation of the displacement including rigid 
ЕЕЕ ОЕ aon translation, and compatibility of the displace- 
ment between elements. 

After having described the kinematical relationships 


between the large and small motions, kinetics is introduced 
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to complete the derivation of the dynamic equations of 
motion. Utilizing the Lagrangian formulation requires the 
definition of generalized coordinates. The description of 
large and small motions are a logical choice for the 
generalized coordinates. The joint variables of the ERLS ` 
and the nodal displacements are the two sets of generalized 
coordinates TERIS. in Lagrange's equations. The kinetic 
energy has contributions from each link, actuators, and any 
loading. The potential energy has contributions from the 
elastic strain energy and from gravity. Generalized forces 
are included due to any applied forces and damping forces. 
After considerable effort in mathematical manipulations, 
rearrangements, and simplifications, the Lagrange equations 
yield two sets of non-linear, coupled,second-order, ordinary 
differential equations. One set of equations describes the 
large motions and the other set of equations describes the 
small motions, though both sets remain coupled. Details of 
the adaptation of Chang's ERLS model to the experimental, 
Single-link, flexible arm are contained in Appendix A. 

The equations of motion for the single-link flexible 
arm are written as two sets of equations, one set consisting 
of one equation for the large motion and one set consisting 
of two equations for the small motion as follows, 


MOO Ө + MON U = FO (1) 


MNO 8 + MNN Ú + KN U = FN 2 
where, 


jus 


Meo ls ІШ Іхт ertia matrix for large motions, 

MON is the 1x2 coupled inertia matrix of the small motion 

Gomer pmrion to the large motion, 

MNQ is the 2xl coupled inertia matrix of the large motion 

comeribution to the small motion, 

MNN is the 2x2 inertia matrix for small motion, 

KN is the 2x2 stiffness matrix, 

FO is the 1x1 load vector for the large motion, 

FN is the 2xl load vector for the small motion, 

8 is the generalized coordinate of the single joint 

variable representing the large motion, 

U is the 2xl generalized coordinate vector of the 

deformations representing the small motion. 

Uta lrzing Hydraulic actuation @emmGhe sangle-link 
manipulator necessitates the derivation and the inclusion 
of the hydraulic actuator dynamics into the equations of 
Mellon ot the flexible arm. The inclusion of the hydraulic 
power system dynamic equations into the flexible manipulator 
equations of motion involves the transformation of an input 
current to an output torque. The servovalve and actuator 
dynamics are included to make the description complete. Moog 
simplifies their servovalve dynamics to a single non-linear 
equation [Ref. 11], 

Q = r K P; CS) 

where O is the flow delivered from the servo valve, 


Mes tmemmput cumsrent, 


m, 


K is the valve sizing constant computed from the flow 
conditions and is the servovalve contribution to the 
S hydraulic system damping 
p is the valve Я drop and is equal to the 
difference between the supply pressure, Por and the 
load pressure drop, Pr: 
The actuator dynamic includes the following continuity 
equation and the torque output equation (Ref. 12, pp. D SEEI 


V, P 
tme 
AE E 


d n. P, D. (5) 


where Q is flow delivered from the servovalve to the 
actuator, 


D 6 is the flow component causing actuator rotation, 


m 
Cim Pi is the leakage flow in the actuator, 
Ve Py 

1 B is the compressibility flow, 


T4 is the required torque delivered to move the load 
and to overcome intertia, 

is the torque efficiency, 

D is the motor displacement, 

б ів the actuator motor angular velocity, 


Bs is the time derivative of the load pressure drop, Pi, 
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C cm "Ex cual leakage Coefficient of the actuator 
mi r ac iator Contribution to the overall hydraulic 
system damping 

V. is the total compressed volume including actuator 
lines and chambers, 


B a is the effective bulk modulus of fluid. 


Values for each of these parameters are computed from 
ШЕ etuator specifications and from good engineering 
judgement. 

The following diagram shows the transformation of the 
EUNcUrrent to an output position and includes the hydraulic 


and flexible manipulator dynamics, 


HYDRAULIC i FLEXIBLE 
ACTUATION MANIPULATOR 
DYNAMICS DYNAMICS 


INPUT 
CURRENT 


OCEPUT 
POSITION 





The preceding hydraulic dynamic equations and relation- 
ships are incorporated into the main computer program for 
solving the dynamic equations of motion for the experimental 
single-link flexible arm listed in Appendix B. 

Computer simulation of the equations of motion for the 
experimental arm and hydraulic actuator required the  solu- 
cono ee Sul taneous, Non-linear, Coupled, second-order, 
ordinary, differential equations. Fortran language and the 


double precision, variable-step, fourth-order, Runge-Kutta 
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integration method available through the Continuous System 
Modeling Program (CSMP) are utilized in coding the simulation. 
Eq. l and 2 can be substituted into a matrix format to 
create a 3x3 coefficient inertia matrix and a 3х1 right-hand 
Side of forces and moments. The unknowns become the large 
motion joint variable acceleration and the small motion 
deformation vector accelerations. The matrix format appears 


as follows: 


MQQ MON 8 = FQ 


MNQ MNN U = EN - “Rew Y 


Construction ol the computer coding involves forming 
each of the elements of the coefficient inertia matrix and 
the force/moment vector in 2 separate subroutine. Once 
formed the elements are assembled into the matrix after 
which an IMSL linear equation solver subroutine is used to 
solve for the accelerations. The accelerations are integrated 
twice using the double precision, variable-step, fourth-order, 
Runge-Kutta integration method available through the Continu- 
ous System Modeling Program (CSMP). Finally a transformation 


from local coordinates to global coordinates takes placeme» 


get global position information on the motion of the arm tip. 
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Initially, the single-link parameters and the motion 
variables initial conditions are input. There is also a need 
to form the various transformation, inertia, and assorted 
other matrices for use later in the inertia and force/moment 
matrix subroutines. Another prerequisite for constructing 
the equations of motion are subroutines for doing matrix 
multiplication and addition, and for doing the matrix opera- 
tions of the transpose and the trace. These subroutines are 
all listed in the copy of the coding in Appendix B. 

Results from the computer simulation and their comparison 
to the actual experimental motion data are discussed in the 


Results chapter. 
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IIT. EXPERIMENTAL APPROACH 


The experimental validation of the Equivalent Rigid Cimi 
System (ERLS) dynamic model on a single-link flexible manipu- 
lator required a significant preliminary design effort. The 
power system for the experimental arm needed to be chosen, 
designed, and purchased. Detailed design of the single-link 
flexible arm needed to be completed and the arm needed to be 
manufactured. Techniques for the measurement of the position 
versus time of the flexible arm tip needed to be investigated 
and a suitable technique chosen. The power system and the 
experimental single-link flexible arm finally needed to be 
assembled into an operational system and the arm tip position 
measurement technique needed to be implemented. 

It was decided to choose a hydraulic system to power the 
experimental arm. The reasons for this choice included the 
desire to increase the Mechanical Engineering Departments' 
exposure to hydraulics and to utilize the knowledge gained 
while taking the Fluid Power Control course. The Naval 
Surface Weapons Center, White Oak, located at Silver Spring, 
Maryland agreed to fund the purchase of the required components 
of the hydraulic power system as a result of their support of 
the robotic research effort in the Mechanical Engines ИШ 


Department at the Naval Postgraduate School. 
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The design of the hydraulic power system involved the _ 
selection of the appropriately sized actuator, servovalve, 
and power unit, as well as the selection of a suitable servo- 
controller, high pressure filter and position transducer. 
Miscellaneous hoses and fittings were obviously also required 
for the final system assembly. 

The power supply selected was a York hydraulic power unit 
that was available in the Mechanical Engineering Department. 
This unit was overhauled and upgraded to include a 3 horse- 
power motor and starter to increase the system supply pressure 
O »50 psi. 

The selection of the servovalve and actuator required the 
following analysis [Ref. 12: pp. 81, 133-138] 

l. Assume a load description of the form 


Vu e Га 


where J is the total moment ог Inertia of the arm 
and the load reflected from the base, 


T is the maximum load torque including the weight 


1 
of the arm and maximum loading (15 1bf) in the horizontal 
position, 

Та is the required torque delivered to move the load 
and to overcome inertia, 

9 is the actuator motor angular acceleration 


2. Assume a design point of 6-45 deg/sec, 0-45 deg/sec* 
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3. The given geometry and dimensions of the arm and loading 


results in the following total inertia, 


у = 74.6942 іп Di T 


4. The maximum load torque including the weight of the arm 


and the loading is, 


Ti = 804.380 in-1bf. 


5. Assume the system supply pressure, Por is 2000 psi and 


that the load pressure drop, Ру, ШЕ ШЕ Ра 1333.3 ЕЕЕ 





Assume the torque efficiency is worst case, ie = abes 
The required displacement of the motor, Ds 1s 
therefore, 
L 
D = 2 = 1.0788 ine 
m NEPI 


The selected actuator must at least have this displace- 
ment.  Bird-Johnson's 3-axis Hyd-Ro-Wrist with a displacement 
in the pitch axis of 4.0 in"/rad was Chosen. The eto 
additionally has yaw and roll axes each with a 1.0 in’/rad 
displacement. However, in this thesis research only the 
pitch axis was utilized and the yaw and roll axes were 
removed. 

6. The selection of the servovalve required an estimation 
of the flow delivered to the actuator at design conditions. 
The continuity equation (Eq. 4) describes the flow to the 


actuator. 
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At design conditions Р, is assumed zero. After using 
good engineering judgement in assuming values for each 
parana ne design flow corrected to rated conditions 


becomes, 
Q-design = .637 gpm 


Moog 760-100 servovalve having a 1.0 gpm rated flow 
was selected. 
7. A Moog servocontroller and a high pressure filter 
assembly were chosen to complete the hydraulic power 
system. A Bourn potentiometer will be used to extract 
large motion rotation data for use with the photography 


measurements in determining arm tip position. 


Ideas for the design of the experimental arm were 
initially investigated by visiting the robotic research 
laboratories at Stanford University and at SRI International. 
The experimental flexible manipulator systems utilized by 
Cannon at Stanford and by Andeen at SRI provided valuable 
information for the design of the experimental arm [Ref. 7]. 
Figures 1, 2 and 3 are photographs of the experimental flexible 
arm and the hydraulic power system. The basic configuration 
of the arm includes two parallel,flexible, steel, flat bars 
connected by thin steel strips to transverse steel bridges. 
The parallel flat bars provide for flexibility in a vertical 
plane only. This flexibility is minimally hindered by the 


transverse bridges because of the thin, connecting, flexible 
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Single-Link Flexible Manipulator System. 


Figure 1. 
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Hydraulic Rotary Actuator. 


Figure- 3. 


Baer Sverse brrzdges increase torsional rigidity 
and reduce the tendency of the arm to twist while in motion. 
Figure 4 1S a photograph showing the inclusion of the trans- 
verse bridges in the flexible arm construction. External 
loading is attached to the arm tip end transverse bridge 

by the securing of the load on the four welded studs. The 
hydraulic actuator is attached to the other end of the 
flexible arm. 

The validation of the ERLS dynamic model requires the 
comparison between the predicted arm tip position from the 
model and the actual arm tip position from the experimental 
single=link manipulator. The computer program listed in 
Appendix B generates the flexible arm tip position referenced 
tomar Dlanat, gü bs соотдіпасе system having the origin at 
the hydraulic actuator rotation axis. The problem of deter- 
mining the arm tip position of an experimental, flexible 
manipulator is far more difficult than that experienced in 
determining the arm tip position of a rigid manipulator. 
There is currently a significant research effort in developing 
accurate techniques for arm tip position measurement and 
control of a flexible manipulator. A brief summary of the 
techniques investigated for possible use in this thesis 
research follows. 

The first technique considered was the crude but effec- 
tive method of taking motion pictures of the arm against a 


ӘРІП ОЗЕК ела АЕ a time CcCoumter in the field of view. 
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Figure 4. Flexible Manipulator Showing 
Transverse Bridges, Tip Loading 
and Grid Background. 
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The arm tip position at any time is manually determined on 
each picture frame by counting the number of grid lines in 
the vertical and horizontal directions. 

Cannon and Schmitz [Ref. 7] utilized an optical sensing 
System of a focusing lens, a photodetector, an amplifier, 
and an A/D converter to acquire position data from their 
horizontally moving, flexible arm. An incandescent light 
bulb was affixed to the tip of the arm and provided the 
light intensity that was received by the optical sensing 
system. This technique appeared to be suitable for its 
specialized application, but may not be as satisfactory in 
general usage. 

The National Bureau of Standards has conducted manipula- 
tor end-point position sensing experiments using an automatic 
laser tracking interferometer system. Initial experiments 
have provided very promising results [Ref. 13]. The signifi- 
cant drawbacks to this laser tracking technique were its 
current high-cost and complicated technology. 

Andeen has utilized strain gages and extrapolated the 
deflection to the arm tip assuming first mode vibration. 
This technique was relatively simple, but may be inaccurate 
unless the predominant mode of vibration is the first mode. 

Interfacing the planar motion of the flexible arm to a 
digitizing tablet provided a potentially feasible technique 
for acquiring arm tip position. This technique would allow 


for automatic, time-efficient, position data acquisition. 
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This technique was obviously only applicable to planar 
motion of the manipulator and was expensive to implement 
for large motion excursions of the arm. 

Lt. William M. Dunkin [Ref. 14] conducted research at 
the Naval Postgraduate School on the use of ultrasonics for 
a position reference system of a manipulator arm. His work 
was preliminary in nature and his experiments utilized a 
stationary manipulator. Despite the poor accuracy of the 
results, use of ultrasonics for arm tip positioning and 
control has significant potential if further research 
continues to perfect this technique. 

Use of a position/displacement transducer that provided 
an electrical signal proportional to the linear extension of 
a cable offered another technique for automatic, position 
data acquisition. Arranging a transcduieerzenzeach piaenaz 
coordinate axis and affixing each cable to the arm tip would 
allow for accurate positioning to occur. To utilize this 
measuring technique would require the inclusion of the cable 
tension in the arm dynamic equations of motion. 

Use of accelerometers followed by two electrical integra- 
tions to yield position information o Mier Eoee Erequeney 
responsé and are commercially available. Use of a digitizing 
vision system for automatic position data acquisition has 
great promise for future robotic applies but IS 


currently very expensive to implement. [Ref. 15] 
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Borschissresearch the use of motion pictures and strain 
gages were selected based on the availability, simplicity, 
and cost. The use of motion pictures in planar applications, 
though tedious, can provide excellent results of arm tip 
position data. Strain gages are utilized to compare the 
uus Stkhail Of che experimental arm to the strain predicted 


by the ERLS dynamic model. 
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IV. Res 


The validation of the ERLS dynamic model includes a 
comparison between the actual arm tip position and the 
predicted arm tip position. The actual arm tip position 
measurements were obtained by taking motion pictures of 
the experimental arm and by a frame-by-frame examination 
of the motion. As an additional check, the MA a 
of strain gages allowed for a comparison between the actual 
strain of the experimental arm and the strain predicted by 
the ERLS dynamic model. 

Evaluation of the plots of experimental and theoretical 
position or strain requires a comparison criteria. Frequency 
and amplitude are the parameters utilized in establishing 
the criteria for comparison.  Similarity in frequency content 
and amplitude is necessary for determination of proper 
control action in the closed-loop servo system design and 
for an accurate representation of the actual motion in any 
flexible manipulator machinery design application. A relative 
percentage error of +/-10% from the experimental results is 
considered the standard for comparison. The strain amplitude 
and frequency errors are computed by taking the difference 
between the theoretical and experimental strain values. The 
strain amplitude is a combination of both fundamental and 


second mode amplitudes but examination of the plots reveals 
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F ше ties mode amplitude is dominant. The strain 
frequency error is separated into the fundamental and 

second mode errors. The tip position amplitude error is 
computed by taking the square root of the sum of the squares 
of the differences between the theoretical and experimental 
X and Y coordinate positions. The tip position frequency 
errors are computed by taking the difference between the 
theoretical and experimental tip position frequencies. Only 
the first mode frequency and amplitude errors are determined 
Ir the arm tip position. The normalization of the absolute 
error to a relative error is accomplished using the arm 
length for the tip position amplitude measurements and the 
experimental strain amplitude for the strain amplitude 
measurements. The experimental frequencies are used for 
normalizing the tip position and strain frequency errors. 
This normalization is accomplished in order to compute the 
appropriate order of magnitude error between the theoretical 
predictions and the experimental results. 

Figures 6, 7, and 8 are plots for three loading conditions 
of the comparison of experimental to theoretical arm tip 
positions in the global X (horizontal) and Y (vertical) 

СОО ШО Sectrons. The three loading conditions are the 
no-load Sotelo спе 5 ропа load condition, and the 10 
КОО ШО Л ШОО ЛОС ОП The excitation of the hydraulic 
actuation for all three loading conditions is a step input 


of 4 milliamps current. The initial condition for these 


experimental runs is the horizontal position of the flexible 
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arm. Experimental arm tip position data requires a prelimi- 
uu paral lax correction and a geometric transformation 
prior to plotting. The parallax c yon is necessary 
because of the relatively close proximity of the camera to 
the experimental arm motion. The geometric transformation is 
necessary because of the offset of the base of the experi- 
mental arm from the axis of rotation of the hydraulic actuator. 
Four CEA-06-12UW-350 strain gages are installed on the 
flexible arm. Two are placed on opposite sides of the 
neutral axis at the base and at the mid-longitudinal 
position of the arm. Consequently, two gages provide 
tensile strain readings and two gages provide compressive 
Strain readings. A mid-longitudinal position gage is 
selected for plotting strain data because of the higher 
Sensitivity, and consequently better resolution, in the 
Strip chart recording. The theoretical strain predicted 
by the ERLS dynamic model in the mid-longitudinal position 
is computed from the Finite Element shape matrix describing 
the transverse or bending displacement of the flexible arm. 
The derivation of the theoretical strain is included in 
Dsum С. Figures 9, 10 and ll are plots for the three 
loading conditions of the comparison of experimental to 
Bor oe ee Wnleroserain.sukzeltation of the hydraulic 
actuation for all three loading conditions is a step input 
ОЁ 4 milliamps current. The initial condition for these 
experimental runs is the vertical position of the flexible 


arm. 
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Utilization of the evaluation criteria of +/-103% error 
reveals the tip position amplitude error is acceptable. This 
is significant considering the importance of tip position 
ШЕРШЕНЕ) ас а crrterra for evaluating robot performance. 
Because of the lack of adequate tip position accuracy for 
certain applications a significant research effort is ongoing 
to develop appropriate tip sensors to compensate for the 
position errors. The acceptable tip position amplitude 
error despite the single element modelling allows for 
usce аәсепкасе ркевстсстопв оі tip position motion and 
consequently suggests the potential usefulness of the ERLS 


model in improving the tip position accuracy. Table I lists 
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the relative percentage errors of tip position amplitude 
for the different loading conditions given a 2.0 mim 


input current to the servovalve. 


TABCE ~I 


RELATIVE PERCENTAGE ERRORS OF TIP POSITION FAN I T Ini; 


The differences in amplitude observed in the arm tip 










position measurements are attributed to the error in 
recording the experimental position data, to the single 
element modelling of the experimental arm, and to the small 
displacement assumption of the vibration. Specifically, the 
frame-by-frame examination of the arm tip position is 
hindered by the lack of clarity of the arm стра M 
absence of definition of the background grid measurement 
lines. Improvement in the grid spacing and color intensity 
and in the camera exposure setting would improve the quality 
of the recorded data. The increased rigidity resulting from 
the single element model of the experimental arm is responsi- 


ble for the amplitude of the theoretical X tip and Y tip 


42 


position data to be less than the experimental position data 
and would increase as the number of elements is increased 
E Ecbemodel. 

Axial deformations are neglected and small bending 
displacements are assumed in the theoretical modelling of 
the experimental arm. The effect of these assumptions is 
noticed in the comparison of the X coordinate arm-tip posi- 
Ron during the first few tenths of a second of motion. 
The experimental arm tip position actually decreases during 
this initial time period. The theoretical model predicts 
an increase in arm tip position, particularly during the 
heavier loading conditions. Figure 12 illustrates how the 
theoretical model could predict an increase in the X coordi- 
nate tip position. The theoretical arm position approximates 
the actual arm position and because the small motion displace- 
ment is measured with respect to the ERLS local coordinate 
axis the theoretical arm length appears to increase. This 
arm length increase is especially amplified with large 
displacements which result from heavier loading. For smaller 
displacements the arm length increase is negligible. The 
increase in the arm length is reflected by an increase in 
the theoretical X coordinate tip position. 

The motion pictures were taken at a camera speed of 24 
frames per second. Since the fundamental and second mode 
frequencies of the experimental arm without any load are 2 


hertz and 13 hertz respectively, only the fundamental 
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ERLS and Theoretical Arm bosirion 
Experimental Arm Position 
Experimental X-Coordinate 

Actual Experimental Arm Length 
Theoretical X-Coordinate 


Theoretical Arm Tip Displacement 
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frequency is observed by the motion pictures. Comparison of 
the frequency content of the experimental and theoretical 

arm tip position reveals close agreement for the fundamental 
frequency. Comparison of the frequency content of the experi- 
mental and theoretical strain reveals that the experimental 
results have lower frequency content compared to the theoreti- 
cal results in both the fundamental and second mode frequencies. 
Utilization of the evaluation criteria reveals the standard of 
+/-10% relative percentage error is exceeded for the second 
mode frequency using the strain measurements. Table II lists 
the relative percentage errors of the frequencies for the 
different loading conditions given a 4.0 milliamp input 


current to the servovalve. 


TABLE II 


RELATIVE PERCENTAGE ERROR OF FREQUENCIES 


Strain Data Fundamental Second Mode 


Мо Load 





Da QDosrtoonWb:sta Fundamental 
No Load ES 
4.3 Kg Load s 5 
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The no-load theoretical fundamental and second mode 
frequencies are predicted to be 2 hepez and 18 hertz 
respectively. The difference in frequency content between 
the theoretical predictions and the experimental гаі с is 
explained in that only one element from the Finite Element 
Method is utilized in modelling the experimental arm. The 
re element model limits the number of degrees of freedom, 
and consequently the flexibility, of the dynamic model. The 
dynamic model therefore appears more rigid than the actual 
experimental arm. Increasing the number of elements in 
modelling the experimental arm would increase the flexibility 
of the dynamic model which would reduce the frequencies of 
predicted motion. Error between the experimental and theoreti- 
cal results is additionally introduced by the limited resem 
tion of the strain measurements from the strip chart recorder. 

Utilization of the evaluation criteria a the 
standard of +/-10% error is exceeded for strain amplitude 
measurements. Table III lists the relative percentage errors 
of strain amplitude for the different loading conditions 
given a 4.0 milliamp input current to the servovalve. The 
amplitude of the theoretical strain measurements are typically 
less than the experimental strain measurements in both the 
fundamental and second mode frequencies. This observation is 
again explained by the limitation on flexibility imposed by 
the single element model of the experimental arm. Increasing 


the number of elements in modelling the experimental arm would 
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increase the flexibility of the dynamic model which would 


result in increased amplitudes of predicted strain. 


Io ЕГ 


RELATIVE PERCENTAGE ERRORS OF STRAIN AMPLITUDE 


Strain Data 










Table 11 indicates that the relative percentage error of 
the first mode frequency increases slightly while the error 
of the N sondenode frequency decreases as the loading is 
applied. Tables I and III indicates that the relative 
percentage error of the tip position and strain amplitudes 
increases slightly as the loading is applied. As mentioned 
before, the first mode amplitude is dominant. With increased 
loading the experimental arm becomes softer or more flexible. 
The dominant first mode strain amplitude and the first mode 
tip position amplitude are slightly more difficult to predict 
as the arm flexibility increases. This observation is con- 
sistent with the slight increase in error in the first mode 
frequency as the loading increases. These trends are consistent 
-with the previous observations that the theoretical predictions 


result in a stiffer system compared to the experimental results. 
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In other words, the single element model better predicts the 
first mode amplitude and frequency of a stiff system compared 
to a softer system. As the loading increases resulting in 

a more flexible system, the first mode strain frequency and 
dominant first mode strain amplitude errors increase slightly. 
Similarly, the first mode tip position amplitude error 
increases slightly. 

The trend of the strain second mode itmequeney 07 
initially appears as an anomaly since the error decreases as 
the loading increases. This trend contradicts the expected 
result that is observed in the first mode frequency and 
amplitude error trends. The trend in the second mode 
frequency error suggests that the theoretical model more 
easily predicts the second mode frequency of a softer system. 
In other words, the theoretical model is better suited for 
predicting the second mode frequency in a flexible system. 
The accuracy of the theoretical model to predict the 
experimental arm deformation is dependent upon the shape 
function approximation of the natural modes. The choice 
of the shape function described in Appendix C to describe 
the deformations results in the observed trend in the strain 
second mode frequency error with loading. 

Investigation of the predicted and actual strains for 
an excitation of 3.0 milliamps current to the servovalve was 
made and revealed similar trends in frequency and amplitude 


errors as noted in the 4.0 milliamps case. As expected, the 
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maximum strains achieved and predicted are less in the 3.0 
milliamps case. However, the relative error percentages in 
the 3.0 milliamps case are not any less than the 4.0 milliamps 
case. This suggests that the small displacement assumption 
has little effect on increasing the strain amplitude and 
frequency errors as the strain is increased. However, this 
suggestion is obviously limited to this particular experiment 
and needs to be investigated for other values of excitation 
ferent. 

The assumptions of single element modelling, of small 
displacement theory, and of no axial deformation are made 
anal yticar expediency and for computational efficiency. 
The validity for making these assumptions should be reviewed 
110. Кодот of these experimental results. 

The importance of correct modelling of the hydraulic 
dynamics was Zea when the interaction of the hydraulic 
actuation, the gravitational force, and the arm movement from 
the vertical plane created a serious resonance problem. This 
phenomenom was observed during the theoretical strain simula- 
tions and resulted in serious instability after approximately 
one second of motion. Investigation revealed that the hydrau- 
lic damping was improperly modeled. The resonance was 


eliminated after a modification to the damping was made. 
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V. CONTROL OF FLEXIBLE MANIPULATORS 


The advantages to employing flexible manipulators is 
well documented in the literature [Ref. 16: pp. 101, 102]. 
However, flexible manipulator usage in industry has been 
minimal principally as a result of the difficulty to СОПЫ! 
the flexible manipulator end-effector [Ref. 3: p. 1209] 

There has been considerable research recently in the 
development of flexible manipulator control strategies 
using state-space model techniques. A brief survey of this 
research follows. 

Cannon and Schmitz [Ref. 1] introduced the concept of 
end-point position feedback for use In controlling fle M 
manipulators. The end-effector position was sensed and was 
fed back to the controller for subsequent determination of 
the control action required by the joint actuators. Use of 
end-point position feedback would increase the response speed 
and would allow for the use of lightweight flexible manipula- 
tors. Techniques for determining the position of the 
manipulator end-point were reviewed in the Experimental 
Approach chapter. 

Cannon and Schmitz [Ref. 7] utilized a modal approach 
with a Lagrangian formulation to model a single-link flexible 
arm. Both large motion rotation and small motion deformations 


of the flexible arm were included inasingle variable in the 


5 


formulation. The state-space model resulted in a set of 
decoupled differential equations where the states included 
the rigid body mode and the flexible modes. Cannon and 
Schmitz limited the state-space model to include only the 
first three flexible modes. The flexible mode states 
included contributions from large motion rotation as well 
as small motion deformations. The joint actuator provided 
direct control action to the large motion rotation of the 
arm. Since the flexible mode states included coupling 
between the large and small motions, the joint actuator 
provided control action to the small motion deformations as 
well. This ensured state controllability of the state space 
model. Output controllability was ensured after determination 
of the arm-tip sensor and the joint-rate sensor measurement 
vectors in the state-space output equation. The joint angle 
and rate were measured with a potentiometer and a tachometer, 
respectively. Since all flexible mode states were not 
measurable, Cannon and Schmitz included an estimator in the 
feedback control system to ensure that the system was observa- 
ble. The Linear Quadratic Gaussian (LQG) approach was 
utilized in the controller design. Experimental verification 
of the feedback control system on a single-link flexible 
manipulator demonstrated that stable and precise position 
control of the end-effector was achieveable. 

Book and Hastings [Ref. 5] similarly utilized a Linear 


Quadratic Regulator approach in designing a controller for a 


Et 


flexible manipulator. Their state-space model consisted of 

a rigid body mode state and the first two flexible modes as 
subsequent states. Their initial formulation of the dynamic 
equations of motion included coupling between the rigid 

body mode and the flexible modes, ald ensured state conte 
lability. Output controllability was ensured after determina- 
tion of the strain gauge sensor, joint-position sensor, and 
joint-rate sensor measurement vectors in the Std tes асе 
output equation. The modal дез were measured from 
strain gauge data.  Observability was ensured by including 

an estimator in the feedback control system to estimate the 
two unmeasured modal velocities. Minimizing the first two 
open-loop modal resonances in an experimental single-link 
flexible manipulator confirmed the feedback control system's 
ability to control the flexible modes. Опе significant 
difference between the Book and Hastings model and the Cannon 
and Schmitz model was that the former utilized flexible modes 
corresponding to fixed-free beam vibrations whereas um latter 
utilized pinned-free beam vibrations. The fixed-free flexible 
mode model allows for a more accurate extension to the multi- 
link manipulator since fixed link boundary conditions describe 
the multi-link physical system. 

Adaptation of Chang's Equivalent Rigid Link System flexible 
model [Ref. 2] to the single-link manipulator provided another 
alternative to the modal approach in defining state variables. 
Defining both large motion rotations and small motion deforma- 


tions as generalized coordinates in the Lagrangian formulation 
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of the dynamic equations provided an easy extension for 
these coordinates to become state variables. A comparison 
of the state-space model to the ERLS non-linear model was 
needed to determine the range of the applicability of the 
linearized model away from the operating point. Comparison 
of simulations of open loop large motion rotation, theta, 
and small motion deformations indicated reasonable agreement 
between the state-space model and the ERLS non-linear model 
for approximately 1.5 sec. or 120 degrees after an input 
torque of 5 N-m was applied. 

The state space representation provided the input to 
the NPS mainframe optimal feedback controls program CONTROLS, 
Барба ат OPTSYS, to design an LOR optimal controller. 
Coupling between the large and small motions included in 
the Lagrangian dynamic equation formulation ensured state 
controllability. After assigning arbitrary identity matrices 
for the output measurement matrix and the weighting matrices 
for the Eni tic performance index, an optimal feedback 
ues matrix was computed Бу the OPTSYS program. 
Details of the linearization and state-space representation 
of the ERLS model and the optimal feedback control design 
are' included in Appendix D. The definition of the output 
measurement matrix assumed the feedback loop was closed 
utilizing tip control. Simulation of the state-space model 
closed-loop response to an initial condition of a 20 degree 


rotation away from the zero degree operating point, a -.08 
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meter tip deflection and a -.l tipaslo5ocegcomriruccs e 
linear feedback control systems' ability to control the 
state-space model of the single-link flexible arm. A graph 
of the linear system closed-loop response of the C motion 
rotation, theta, is plotted in Figure 13. This result gives 
some confidence in the linear controller's ability to control 
the non-linear model given small perturbations about the 
Operating point. However, simulation of the linear controller 
with the non-linear model is necessary to investigate the 
range of operation. 

Utilizing the arm-tip deflection and slope as state 
variables appears to be an improvement over the flexible 
mode state variables since the former are more easily 
measurable quantities. The need for an estimator in the 
feedback control system may be eliminated. However, addi- 
tional comparison and investigation of the merits of both 
approaches are necessary. From the results obtained from 
other research it appears that control of a single-link 
flexible manipulator is realizable. Extension of these 
feedback control system approaches to multi-link flexible 
manipulators is necessary if the advantages of flexible 
manipulators is to be realized in practical industrial 


applications. 
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VI. CONCLUSZ CNS 


The purpose of this research is to experimentally 
validate the ERLS dynamic model. The validation of the 
ERLS dynamic model is needed to ensure confidence of the 
model for use in future design and control applications. 

In this research, the ERLS model is tailored to a single- 
link flexible arm having hydraulic actuation anc cu VENE 
a vertical plane. The vertical plane motion introduces 
the effects of gravity. The investigation of the effects 
of gravity on flexible manipulator movement allows for the 
consideration of applications not limited to space usage. 
The investigation of hydraulic power actWazion allows MES 
the consideration of heavy load applications. The effects 
and interactions of modelling the flexible arm with gravity 
and the hydraulic actuation revealed the importance of 
proper determination of parameters, specifically those 
affecting damping. 

The acceptable tip position amplitude error despite the 
Single element modelling suggests the ERLS model's potential 
usefulness in improving the tip position accuracy. This 
potential benefit is significant considering the importan 
of tip position accuracy as a criteria for evaluating robot 


performance. 
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The results of the validation indicated the theoretical 
strain and position measurements are affected by the under- 
lying assumptions of the ERLS model. Specifically, the FEM 
single element modelling of the experimental arm results in 
a more rigid description of the actual motion and gives 
smaller amplitudes and higher frequencies. The results 
indicate that as loading is applied to the single element 
model the relative percentage errors of the first mode 
amplitude and frequency increase slightly. As loading is 
applied, the experimental arm becomes more flexible and the 
single element model's performance in predicting the first 
mode motion degrades. The results indicate though that the 
single element model is better suited for predicting the 
second mode frequency as the loading is increased. The 
relative percentage errors for frequency indicate, however, 
that the single element model better predicts the first mode 
motion compared to the second mode motion. 

The small displacement assumption results in additional 
error to the theoretical strain and position predictions. 
This error is most noticeable during the initial stages of 
the X coordinate tip position motion and increases as the 
loading increases. The small displacement assumption does 
not appear to have much effect though,on the strain nannte 
and frequency errors as evidenced by the lack of any error 
increase as the strain is increased by a larger hydraulic 


excitation current. This conclusion needs to be investigated 


y 


for other excitation current values. Other assumptions 
are made on the values of certain mechanical and hydraulic 
parameters, particularly inertia properties of the arm and 
actuator. These assumed values undoubtedly geo Sue to 
the error in the theoretical predictions. The agreements 
and differences between the simulation and the experiment 
in both arm-tip position and strain measurements provide a 
valuable validation of the ERLS model. The experimental 
data serves as a guideline to upgrade the dynamic model, 


particularly in the validity of the underlying assumptions. 


OS 


МІ "RECOMMENDATIONS 


A principal goal in this research is to eventually use 
the ERLS dynamic model in the design of a complete flexible 
manipulator system. This system would include a multi-link 
meextiole Manipulator and a servo control loop. Two areas of 
research needed to achieve this goal are, therefore, the 
Sentrol system design and the optimal design of a flexible 
manipulator. 

Continued simulation studies of a closed-loop system 
having the controller design based on the ERLS model are 
needed. Alternative control laws need to be investigated 
for possible use in this application. Concurrent work is 
needed on the continued validation of the ERLS dynamic model. 
Specifically, the single element FEM modelling of deformations 
should be extended to a multi-element model. Validation of 
the arm and actuator inertia properties needs to be accom- 
plished. The intent of the continued validation of the ERLS 
dynamic model is to bring the theoretical arm motion into 
closer agreement to the experimental arm motion. This 
refinement of the dynamic model is useful for an effective 
controller design based on the model. Additional techniques 
for the acquisition of arm tip position need to be investiga- 
ted and implemented. Specifically, sensors for arm tip 


position need to be implemented in order to feedback position 
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data to the controller for dappropriateveetero soe ene. 
Alternatives for arm tip position sensors @nclude accelenes 
meters and optics. The controller design eventually needs 
to be implemented in hardware and/or software and tested. 
Extension of the controller design and implementation to 
the multi-link case is eventually needed if the advantages 
of flexible manipulators is to be realized in practical 
industrial applications. 

Once experimental validation is completed the ERLS 
dynamic model will allow computer simulation for designing 
a mechanical manipulator with a desired rigidity. Further 
investigation is needed into the optimal design of a flexible 


manipu kator. 
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APPENDIX A 
DERIVATION OR-THE EQUEITLIONS*OF*MOTION*FOR THE 
EXPERIMENTAL, SINGLE-LINK, FLEXIBLE ARM 
Given the large and small motions as generalized coordi- 
nates, the following are the two sets of Lagrange equations 


used to develop the equations of motion: 


ШЕР ӘКЕ/909) = 9KE/98 + ӘРЕ/098 = F (А.1) 

ШПЕ(ӘКЕ/ӘШ) = 9SKE/9U + ӘРЕ/ӘУ - 0 (А.2) 

КЕ - kinetic energy 

PE - potential energy 

8 - large motion joint variable, theta 

U - 2xl vector of small motion displacement and slope, v 
and ф 

F - generalized force for large motion, applied moment 


The actual motion of the experimental arm is restricted 
to lie in a vertical plane. The hydraulic actuator is 
attached.to the base of the arm. The load is attached to the 
end of the arm. The large motion joint variable theta is the 
angle measured between the ERLS link and the global coordi- 
nate system horizontal axis. 

The origin of the global coordinate system is the axis 
of the hydraulic tor, the base joint. 

The horizontal and vertical axes of the global coordinate 
system are parallel and perpendicular to the earth. The ERLS 


link is parallel to the tangent of the experimental arm at the 


Onl 


base joint. Figure A.l shows the relationships between the 
ERLS and the theoretical arm position. The vector of small 
motion is limited to include only the transverse displacement, 
v, and the slope, o>, of the end of the arm. Axial deformation 
and torsion are neglected in the model and are considered 
insignificant in this application. The design of the experi- 
mental arm to include two parallel flat bars jointed by a 
series of transverse bridges makes the arm rigid in torsion. 
Figure A.l shows the two components of the vector of small 


motion: 





Figure A.l 


BI 

Theoretical Arm Position 
Global Coordinate System 
Local Coordinate System 

Arm Tip Deflection 

Arm Tip Slope 
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KK 
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ШЕЕ uoncsctrecsuergvoorctheosystem includes contributions 
ӘБІШ ЕПЕ асғп, tac loading апа the hydraulic actuator rotor. 
The expressions utilized for the determination of the kinetic 


energy of the system are as follows: 


KE-arm = 1/2 | u I (R)dv m 
ARM 
VOLUME 
KE-load = 1/2 Tr | E (R,)dv (A.4) 
LOAD VOLUME 
I x de 

KE-rotor = 1/2 Tr | 5 (R,.) dv (A.5) 

ROTOR 

VOLUME 


Tr is the trace operation. 
The global position vector of the arm is determined from 


the following transformation: 


Be wir + р) (ДО) 

W - the 3x3 transformation matrix and is solely a 
function of theta 

r - the 3x1 local position vector of the arm measured 
from the coordinate system whose origin is at the end of 
the ERLS link. Figure A.l shows the positive directions 


for the local coordinate system. 


63 


D - the 3xl deformation vector that only includes the 
transverse displacement, v. In order to introduce the nodal 
displacements at the arm tip as the sole deformation variables 
substitution of the shape function matrix and a nodal dis- 
placement vector is made for D. The derivation of this 
substitution is shown in Appendix C. 

U = the mass density of the arm, steel 

The global position vector of the load is determined from 


the following transformation: 


R, = W D (A.7) 


1 С 
D4 - the 3x3 transformation matrix due to the local 


deformations of the arm tip 


Ly 7 the 3x1 local position vector for the load 


My 7 the mass density of the load, steel 


The global position vector of the hydraulic actuator 


rotor is determined from the ГОО НОЕ ИСЕ ЫНА ЕДЕННЕН 


B = A (A.8) 
Ë r < 


А 
1 


the 3x3 transformation matrix NEL tostue Lange 


motion rotation of the rotor 
r, - the 3xl local position vector for the rotor 


lo the mass density of the actuator rotor, aluminum 


The following definitions for the inertia terms are 
utilized to simplify the computations and the resultant 


expressions in the equations of motion: 
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T; = | Hi rq rl dv - the 3x3 inertia matrix of the load 


LOAD 
VOLUME 
ІТ = Ш ТУ Г Е av ="the 3х3 anertia matrix of the 
r Fo ri r 
асаа сосот 
КОТОК 
VOLUME 
т“ i TE > 
MIN . Wo) | и фу Wow, $, dv 
LINK 
VOLUME 
о) = Ц 61° "m W $4 dv 
LINE 
VOLUME 
о) Ш 9) Wow, r dv 
Í 9 E Ө 
LINK 
. VOLUME 
i М UID 
Illl(W, ; W.) = | ur Wa Wa ау 
LINK 
VOLUME 
T _ TNT 
Ill12(W, , W) = | Ші Wa W $4 dv 
LINK 
VOLUME 
T : E TN 
I122(W, , W) | uo, Wy Wo, dv 
LINK 
VOLUME 
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(A. 


(A. 


(A. 


9) 


10) 


ne) 


55021) 


ШЭ) 


22) 


ИБ) 


16) 


T B Тт т 
I122(W, , Wo.) = | u$. м М фу dv (A.17) 
LINK 
VOLUME 
T = H у“ ау | (A.18) 
үу 1 ' 
LOAD | 
VOLUME 
—— NET (A. 19) 
XX — | ТҮ I 
LOAD 
VOLUME 


Computation of the preceding link inertia matrices requinme 
utilization of the 3x2 link shape matrix фу, the 3xl link 
local position vector r, and various combinations of the 25 
transformation matrix W. The expression Wo implies a deriva- 
tive with respect to the large motion joint variable, theta. 
The expression W. results from a simplification of the second 
time derivative of the transformation matrix W and is termed a 
residual acceleration. Further details on the derivation of 
these expressions can be found in Reference 2 and a listing of 
these matrices is found in Appendix B in the computer coding. 

The potential energy of the system includes contributions 
from the strain energy of the arm due to deformation and from 
the gravitational energy of the load and the arm. The 
expressions utilized for the determinaticn of the potential 


energy of the system are as follows: 


PE, = 1/2 ET (ERES dx - potential energy due to 
a + deformation (A.20) 
LINK 
LENGTH 


66 


РЕ = = | H ri Gg Ard V - potential energy of the link 


due to gravitation (А21) 
LINK 
VOLUME 
PE, = = | My ey" g dv - potential energy of the load 
3 due to gravitation 5222) 
LOAD 
VOLUME 
RI ei О ОГ О СОПУ Inethe z direction, or 


ZZ 


perpendicular to the plane of motion. 

у! - the second derivative of the transverse 
displacement v with respect to the x local coordinate 
direction. In order to introduce the nodal displacements 
at the arm tip as deformation variables substitution of the 
second derivative of the shape function matrix with respect 
to the x coordinate direction and a nodal displacement 
Mmeeeor is made for v''. The derivation of this substitution 
1s shown in Appendix C. 


g - the gravitational acceleration vector 


The following definitions are utilized to simplify the 
computations and the resultant expressions in the equations 


f motion: 


Куч = | rt С Г ах - the 2x2 stiffness matrix 55223) 
LINK 
LENGTH 
Нуу = | u rt mU Nn qtlirst moment of inertia 
vector Л) 
LINK 
VOLUME 
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Hoy = | H p, dv - the link shape matrix first 
moment of inertia vector СА 02050 
LINK 
VOLUME 
Hay = | Hi Ка áv - the load first moment or алс iA 
vector (A.26) 
LOAD 
VOLUME 
T - the second derivative of the shape function matrix. 


C - the 3x3 flexural rigidity matrix iMmeludinc om, 


Substitution of the expressions for kinetic energy and 
potential energy into the Lagrange equations and after much 
computation and simplification results in the following two 
non-linear, coupled, second-order, ordinary, differential 
equations for the large and small motions of the single-link 


flexible arm: 


MOO 8 + MON U = FO (ADN 


MNO 6 + MNN U + KN U = FN (A.28) 


The following are definitions for the coefficients: 


ШЕ 


_ T T 
МОО = 1111 (W, ; Wo) + U I122(W, ; W.) U + Trace (W, DI} 
De m... (А. Ж 
1 Ө i т==г 
_ T | 
МОМ = I112(Wg QW) + ( (Mj L + м), (M. I L x + I 
(А. 0p 
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L is the link length. M is the first moment of the load 
with respect to the local coordinate y axis. Mi is the mass 


of the load. 


= Jt 2 T ° ^ T T ШІ E 
FO - 2. U I122(W, , W) Ü * Hi, W^ g € U. Hj W," g 
есе (чр т. рін + 2 WD. I. D.- Wea e s 
8 1 l1 1 ds š s | ARDET ror rr 
Tm ШІ 


T is the externally applied torque. A results from a 
Simplification of the second time derivative of the transfor- 
mation matrix А. and is termed a residual acceleration. U 
is the 2x1 nodal displacement vector containing the link tip 
deflection, v(0), and slope, $(0). The expression Ag 
implies a derivative with respect to the large motion joint 


varıable, theta. 


T El 


E Als 
MNO = (Trace (W.D. I4 Dii W), Trace (W. D4 I ру: W )) 
on, W.) | (A. 32) 
D and D are the derivatives of the arm tip 


ЛЕК 12 


deformation transformation matrix with respect to each nodal 
displacement, deflection and slope, respectively. 

M. 0 v (0) 
МММ - I122(wl,w) + (A.33) 


0 I 3 6 (0) 


— = À— 
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v (0) and $ (0) are arm tip deflection and slope 


accelerations respectively. 


E T E 
KN =" s I122(W , М.) (A. 34) 
_ TE 4 T "M т 
T 7, qug o: ет 
Weyer Trace (W D, I} D}, W + 2. WD, 1, Dj, W 95) 
Tap T AT 
+ (Hy, D,, W g, Hj Di, W g) (А. ЗЫ 


The numerical values utilized for the experimental 
flexible arm system variables are listed in Appendix B and 


are in SI units. 
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APPENDIX B 


LISTING OF THE FORTRAN CODING UTILIZED IN SOLVING 


THE DYNAMIC EQUATIONS OF MOTION FOR THE EXPERIMENTAL 


SINGLE-LINK FLEXIBLE ARM 


SIMULATION OF SINGLE LINK FLEXIBLE MANIPULATOR DYNAMICS 


THIS PROGRAM SOLVES THE ERLS FLEXIBLE MANIPULATOR DYNAMICS FOR A 
SINGLE LINK EXPERIMENTAL ARM. THE EXPERIMENTAL ARM PARAMETERS ARE 
INPUTTED AND THE HYDRAULIC ACTUATION DYNAMICS ARE INCLUDED IN THE 
SIMULATION. THE INPUT IS THE CURRENT TO THE SERVOVALVE MOUNTED ON 
THE HYDRAULIC ACTUATOR AND THE OUTPUT IS THE POSITION OF THE ARM 
TIP IN THE GLOBAL REFERENCE SYSTEM. THE CODING CONSISTS OF A MAIN 
PROGRAM AND FIFTEEN SUBROUTINES AND ARE DESCRIBED BELOM. 


THE FOLLOWING PARAMETERS ARE DEFINED: 

1.A-EFFECTIVE CROSS-SECTIONAL AREA OF FLEXIBLE ARM 

2.ARRDD-3X3 SECOND TIME DERIVATIVE OF ROTOR RESIDUAL ACCELERATION 
MATRIX 

3.ARTH-3X3 ROTOR TRANSFORMATION MATRIX DIFFERENTIATED WITH RESPECT 
ТО ТНЕТА 

4. BESEFFECTIVE BULK MODULUS OF FLUID 

5.BIGF-3X1 RIGHT-HAND SIDE VECTOR FOR LARGE AND SMALL MOTION 
ACCELERATIONS 

6.BIGM-3X3 MATRIX OF LARGE AND SMALL MOTION ACCELERATION 
GUEFFICIENTS 

7.CTM-TOTAL LEAKAGE COEFFICIENT OF THE ACTUATOR 

8.DEFM-DISPLACEMENT DEFORMATION VARIABLE 

9.DEFMD-TIME DERIVATIVE OF DISPLACEMENT DEFORMATION VARIABLE 

10.DIFF,QERR, QERR1,FACTOR-DUMMY VARIABLES 

11.DL1-3X3 DEFORMATION MATRIX 

12.DL11 3X3 DEFORMATION MATRIX DIFFERENTIATED WITH RESPECT TO THE 
DISPLACEMENT DEFORMATION VARIABLE 

13.DL12-3X3 DEFORMATION MATRIX DIFFERENTIATED WITH RESPECT TO THE 
SLOPE DEFORMATION VARIABLE 

14.DL1D-3X3 FIRST TIME DERIVATIVE OF DEFORMATION MATRIX 

15.DM-ACTUATOR DISPLACEMENT 

16. E-M0DUPBUS OR VELASTICITY OF STEEL 

17 .FN=2X1 RIGHT-HAND SIDE VECTOR FOR SMALL MOTION ACCELERATIONS 

18.FQ-RIGHT-HAND SIDE FOR LARGE MOTION ACCELERATIONS 

19.6-5Х1 GRAVITATIONAL ACCELERATION VECTOR 

20.GPOS-3X1 GLOBAL POSITION VECTOR FOR ARM TIP 

¿ISLAS EINK FIRST MOMENT OF INERTIA VECTOR 

22.H21-2X3 LINK SHAPE MATRIX FIRST MOMENT OF INERTIAVECTOR 

23.H%1-1X3 LOAD FIRST MOMENT OF INERTIA VECTOR 

Come CE-emat FLOW PRESSURE COEFFICIENT 

25.PL-LOAD HYDRAULIC PRESSURE DROP 

26 ЕБЕ СТС SUPPEY PRESSURE 

27 .QL-FLOWN DELIVERED FROM THE SERVOVALVE 

28.SLOP-SLOPE DEFORMATION VARIABLE 

СО ЭОЕ ТЕ DERIVATIVE ОР 510РЕ DEFORMATION VARIABLE 

30.SOL-3X1 VECTOR OF LARGE AND SMALL MOTION ACCELERATIONS 

31.TE-TORQE EFFICIENCY 

32.TH-LARGE MOTION POSITION VARIABLE 

33.THD-TIME DERIVATIVE OF LARGE MOTION VARIABLE 

34 .TORQUE-APPLIED TORQUE BY ACTUATOR 


35.U-2X1 ARM TIP DEFORMATION VECTOR INCLUDING DISPLACEMENT AND SLOPE 
36 .UD-2X1 ARM TIP DEFORMATION VECTOR DIFFERENTIATED WITH RESPECT TO 


TIME 


37.VT-TOTAL COMPRESSED VOLUME INCLUDING ACTUATOR LINES AND CHAMBERS 


38.W-3X3 LINK TRANSFORMATION MATRIX 
39.WD-3X3 FIRST TIME DERIVATIVE OF LINK TRANSFORMATION MATRIX 
EE "un SECOND TIME DERIVATIVE OF LINK RESIDUAL ACCELERATION 
MATR 
Е TRANSFORMATION MATRIX DIFFERENTIATED WITH RESPECT TO 
A 


p 


X X OK OK OK OK OK OK OK OK OK OK OK OK OK OK OK OK OK OK OK OK OK OK OK OK HA OK X OK KK 
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жж ж 


Жжжж ж жж ж 


K KOK KK XK 


ж 


VALVE 
G2.XIINP-CURRENT INPUT EQUAL TO INITIAL AND FRACTIONAL AMOUNTS 
G3.XIL-3X3 INERTIA MATRIX OF THE LOAD 
4G.XIO-INITIAL INPUT CURRENT TO SERVOVALVE 
45.XIR-3X3 ROTOR INERTIA MATRIX 
G6.XISTEP-STEP INPUT OF FRACTIONAL AMOUNT OF INPUT CURRENT 
47 .XK11-2X2 PARTTAU LIK STIGENESS MATa | 
48 .XKN-2X2 LINK STIFFNESS MATRIX Е 
49 .XKV-SERVOVALVE SIZING CONSTANT 
50.XLL-LEHGTH ОҒ FEENBBEE ARM 
51.XML-MASS OF LOAD 
52.XMNN-2X2 COEFFICIENT MATRIX OF SMALL MOTION ACCELERATIONS IN THE 
SMALL MOTION DYNAMIC EQUATIONS 
53.XMNQ-2X1 COEFFICIENT VECTOR OF LARGE MOTION ACCELERATIONS IN THE 
SMALL MOTION DYNAMIC EQUATIONS 
54.XMQN-1X2 COEFFICIENT VECTOR OF SMALL MOTION ACCELERATIONS IN THE 
LARGE MOTION DYNAMICS EQUATION 
55.XMQQ-COEFFICIENT OF LARGE MOTION ACCELERATION IN THE LARGE MOTION 
DYNAMICS EQUATION 
ы DUMMY MATRIX FOR USE IN FORMULATING THE EQUATIONS OF 
MOTI 
57 .XMR-MASS OF ACTUATOR ROTOR 
58.XMU-MASS DEMSITY OF STEEL FLEXIBLE ARM 
Маса й MOMENT OF LOAD WITH RESPECT TO THE LOCAL COORDINATE 
Y. AXI 
60.XXI-VARIABLE REPRESENTIHG INERTIA-LIKE LOAD PROPERTY 
61.YYI-VARIABLE REPRESENTING INERTIA-LIKE LOAD PROPERTY 
62.ZI-AREA MOMENT OF INERTIA OF FLEXIBLE ARM 


INITIAL 
INITIAL VALUES OF PARAMETERS ARE INPUTTED VIA XINIT SUBROUTINE 


REALX8 UC2,1),XMQQC1),XMQQP(2,2),DL103,3),WTHC3,3),ARTHC3,5), 
#XIRC3,3),XMQNC1,2),UD02,1),H1101,3),605,1),H2102,3), 
#HRDDC3,3),DL1D03,3),NDC3,35),ARRDDC3,33,HG101,3),XK1102,2), 
#DL1203,3),XMNQC2,1),NC03,3),XMNNC2,2),XKNC2,2),FNC2,1),BIGMC3,3), 
tBIGFCS,120, XILCS, 5»), DL11C 5, 55), DEFMDC12, S0LC 5D, THDC1D, SLOPC1), 


$8S5LOPDC12,AC125,EC15,ZICID, XXICIO, YYICIOPEWCIOMNBBOSCSOU XT ; 
$8XMUC12,XLLC12, XMLC12, XMRC12, XMXC12, THC12, TORQUEC12, DEFMC1), 
SPSC1),XIFRACC12,XIO0CIO,KCEC12D,VTC12, BEC12, DMCIO, XKVC12, TEC12D, 
#QL(1),PL(1),DIFF(1),XIINP(1),QERR1(1),QERR(1),FACTOR(1),XISTEP(1) 
FIXED I 

NOSORT 


SYSTEM DPINTG 

4TH ORDER RUNGE-KUTTA DOUBLE-PRECISION INTEGRATION 

METHOD RKSDP 

INITIALIZATION SUBROUTINE 

CALL XINIT(CTH, THD, DEFM, DEFMD, SLOP, SLOPD,VO,POSO,A, XML, XMU, . 


XLL,XMR,E,ZI,PS,XIFRAC,XIO,CIM,VT, BE, DM, XXV, TE,QL, ... 
PL, PLIC) 


DYNAMIC 
COEFFICIENTS FOR BOTH LARGE AND SMALL MOTION ACCELERATIONS 
AND THE RIGHT-HAND SIDES ARE COMPUTED IN THE FOLLOWING 
SUBROUTINES. ALSO,THE HYDRAULIC DYNAMICS ARE INCLUDED 
IN THE MAIN PROGRAM. 


NOSORT 
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ж ж 


жж ж XK A OX X OK Жжжж ж жж ж Жжжж ж жж ж жж ж Жжжж ж Жжжж ж жж ж 


Жжжж ж 


HYDRAULIC DYNAMICS 


ЖШЕШЕРСІЛЕ ПЕКАССТ)Ж5ТЕР(0.0) 
КЇТМРС1)У=ХТОС1Т)+ХТ5ТЕРС1) 
I 6 (1) IRA) Со TO 2 


GO TO 3 

РШ 1)=Р5(1) | 
SERRICIOSOSPINPCIOXAKVCIOXDSQRTCPSCIO-PLCIODO-CDMCIOXTHD(1)2 
QERR(1)=QERR1C(1)/KCEC 

UPMEECIOSQERRCIO-PLCI) 

FACTOR(1)=VT(1)/(6,0DOXBE(1)XKCEC1)) 

ОЕЕО = ОЕЕО) 

SORT 

PLI-INTGRLCPLIC,DIFF1,1) 

NOSORT 


PL(1)=PL1IC1I)/FACTORCI) 
TORQUECIO-TECIOXPL(CIOXDM(CIl) 


MATRIX AND VECTOR FORMULATION SUBROUTINE 

CALL FORMCW,WTH,WD,DL1,DL1D,XIL,XIR,ARTH,WRDD,ARRDD,U,UD,... 
XMQQP,G, ЕО Oa. hols AKL. A> ANU,ANL,ALL, TH, THD; ° ° ° 
DEFM,DEFMD,SLOP,SLOPD,E,ZI,XMR,XMX,YYI,XXI) 


COEFFICIENT OF LARGE MOTION ACCELERATION IN LARGE MOTION DYHAMICS 
EQUATION SUBROUTINE 


CALL XLMMQQCXMQQ,U,XMQQP,DL1,WTH,ARTH,XIL,XIR,A,XMU,TH,DEFM,SLOP) 


COEFFICIENTS OF SMALL MOTION ACCELERATIONS IN LARGE MOTION DYNAMICS 
EQUATION SUBROUTINE 


CALL XLMMQNCXMQN, A, XMU, XML, XLL, XMX, SLOP, DEFM, YYI, XXI) 

RIGHT-HAND SIDE FOR LARGE MOTION DYNAMICS EQUATION SUBROUTINE 
CALL XLMFQCFQ,U,XMQQP,DL1,WTH,ARTH,XIL,XIR,UD,H11,G,H21,WRDD,... 
DLID,WD,ARRDD,H41,7H,THD, DEFM, DEFMD,SLOP,SLOPD,A,XMU,XML,XLL,... 
TORQUE) 

LINK STIFFNESS MATRIX SUBROUTINE 

CALL SMKNCXKN, XK11,XMQQP,A,XMU,THD) 


COEFFICIENTS OF LARGE MOTION ACCELERATION IN SMALL MOTION 
DYNAMICS EQUATIONS SUBROUTINE 


CALL SMMNQCXMNQ, DL1,WTH,XIL,DL11,DL12,W,TH,DEFM,SLOP,A,XMU) 
RIGHT-HAND SIDE OF SMALL MOTION DYNAMICS EQUATIONS SUBROUTINE 


CALL SMFNCFN,H21,W,G,WNRDD,DL1,XIL,DL11,DL12,WD,DLID,HG1,TH,... 
THD, DEFM, DEFMD,SLOP,SLOPD) 


COEFFICIENTS OF SMALL MOTION ACCELERATIONS IN SMALL MOTION DYNAMICS 
EQUATIONS SUBROUTINE 


CALL SMMNNCXMNN, XMQQP,XML,A,XMU,XXI,YYI,XMX) 


ACCELERATION COEFFICIENTS MATRIX AND RIGHT-HAND SIDE VECTOR 
FORMULATION SUBROUTINE 


CALL BIGFORCB:GM, BIGF, XMQQ,XMQN, FQ, XMNQ, XMNN, XKN, FN,U) 
LINEAR EQUATION SOLVER FOR ACCELERATIONS SUBROUTINE 
CALL XLEQCBIGM, BIGF,SOL ) 


TRANSFORMATION FROM LOCAL COORDINATE TO GLOBAL COORDINATE TIP 
POSITION SUBROUTINE 


CALL GLOB(GPOS,W,DEFM) 


TS 


ж ж ж 
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X X OK X 


CALL GLOBCGPOS,W, DEFM) 


INTEGRATE ACCELERATIONS AND THEN VELOCITY TO GET LARGE MOTION 
E AND SMALL MOTION,LOCAL COORDINATE,TIP POSITION 
SOL1(1)=SOLCT) 

CONTINUE 

SORT 

VEL=INTGRL(VO,SOL1,3) - 
NOSORT 

THD(1)=VELC1) 

DEFMDC(1)=VEL (2) 

SLOPD(1)=VEL(3) 

DO 10 1=1,3 

VELICIO-VEL(CI) 

CONTINUE 

SORT 

POS-INTGRLCPOSO,VELI1,3) 

NOSORT 
TH(1)=P0S(1) 
DEFM(1)=P0S(2 
SLOP(1)=P0S(3 
ACI=ZZRNDCSOL 
AC2=ZZRNDCSOL 
AC3=ZZRNDCSOL 
VEL=ZZRNDCVEL 
VE2-ZZRNDCVEL 
VES-ZZRND(CVEL 
POI-ZZRND(CPOS 
PO2-ZZRNDCPOS 
POS-ZZRNDCPOSC 
XPOS=ZZRNDCGPO 
YPOS-ZZRNDCGPOS 
TORK=ZZRNDCTORQ 
LPD-ZZRNDCPLC1)) 


OUTPUT GLOBAL COORDINATE TIP POSITION 


) 
) 
1 
1 
1 
( 
( 
( 
( 
( 


TERMINAL е, 
OUTPUT XPOS 

OUTPUT YPOS 

OUTPUT TIME,XPOS 

PAGE XYPLOT 

LABEL X-POSITION (LOAD=.6233 KG ,I=1.02MA) 

OUTPUT TIME, YROS 

PAGE XYPLOT 

LABEL Y-POSITION (LOAD=.4233 KG ,I=1.02MA) 

TIMER FINTIM =1,5 , OUTDEL = 0:01, DECMEN = 9 0Е-6 


LISTING OF SUBROUTINES 


SUBROUTINE XINITCTH,THD, DEFM, DEFMD,SLOP,SLOPD,VO,POSO,A,ML,MU,LL, 


#MR,E,ZI,PS,IFRAC,IO,CTM,VT,BE,DM,KV,TE,QL,PL,PLIC) 


REALx8 VOC3),POSOC3),ML,MU,LL,MR,TH,THD,DEFM,DEFMD,SLOP,SLOPD, 


#A,E,ZI,ITORQ,PS,IFRAC,IO,CTM,VT,BE,DM,KV,TE,QL,PL,PLIC, IMAX, 


ITORQ= 27.89303003D+00 
DM-6.2271D-05 
TE=.9D+00 
PL=ITORQ/CDMXTE) 
PLIC=PL 
CTM=3.7064772D-13 
QL=CTMXPL 
KV=2.402963D-09 
PS=1.3/8388D+07 

IO0=QL/ CKVXDSQRTCPS-PL)) 
IMAX=10.D+00 
IFRAC=.5D+00X(IMAX-10) 
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OOM 


BE-690.D6 

A-6.17795D-06 
ML=.42330000000000 
MU=7861.05000000000000 
LL=0.99850000000000 
MR-9.00011651000000 
Е=2.0011 

Z1=4.065D-10 
У0(12:0.000000000000000 
М0с2) =0.000000000000000 
V0C35-0.000000000000000 
POSOC1)=0.00000000000000 
POSOC2)=-.07804116400000 
POSOC3)=-.09875534300000 
TH-PO0SO0(1) 

THD=V0(1) 

DEFM=P0S0C2) 

DEFMD=VOC 2) 

ЭШӘР-Р050( 5) 

SLOPD=V0( 3) 

RETURN 

END 


SUBROUTINE FORMCW,WTH,WD,DL1,DL1D,XIL,XIR,ARTH,WRDD,ARRDD,U,UD, 
$XMQQP,G,H11,H21,DL11,DL12,H61,XK11,A, MU, ML, LL, TH, THD, DEFM, DEFMD, 
SPOS SLOPD, E, ZI, MR; MX, YYI, XXI) 

REALX8 WC(3,3),WTHC3,3),WD(3,3),DŁ1(3,3),DŁ1D(3,3) 

REALX8 XIR(3,3),ARTHC(3,3),WHRDDC(3,3),ARRDD(3,3),U( 

REALX8 XMQQP(2,2),6(3,1),H11(1,3),H21(2,3),DL11(3 

REALX8 H41¢01,3),XK1102,2),MU,ML,LL,MR,MX, TH 

REALX8 THD,DEFM, DEFMD,SLOP,SLOPD,XXI,YYI,A,E,ZI 

WN(1,1)=1.00000000000000 

WN(1,2)=0.00000000000000 

N(1,3)=0.00000000000000 

WO2,1)=LLXDCOSCTH) 

WC2,2)=DCOSCTH) 

WC2,3)=-DSINCTH) 

WO3,1)=LL¥DSINCTH) 

WO3,2)=DSINCTH) 

WO3,3)=DCOSCTH) 

WTHC1,1)=0.00000000000000 
NTHC1,2)=0.00000000600000 
WTHC1,3)=0.00000000000000 
WTHC2,1)=-LLXDSINCTH) 

NTHC2,2)=-DSINCTH) 

WTHC2,3)=-DCOS(TH) 

WTHCS3,1)=LL¥DCOSCTH) 

WTHC3,2)=DCOSCTH) 

WTHC3,3)=-DSINCTH) 

WDC1,1)=0.00000000000000 
NDC1,2)=0.00000000000000 

WDC1,3)=0.00000000000000 


X1L (3,3) 
TOS) 


2 
, 3), DL12C 5, 3) 


NDC2,1)=-LLXADSINCTHIXTHD 
WDC2,22--DSINCTHOXTHB 
WDC2,3)=-DCOSCTHIXTHD 
WDC3,1)-LLXDCOSCTHOXTHD 
NDC32,2)-DCOSCTHOXTHD 
WDC3,3)=-DSINGTHIXTHD 
DL1(1,1)=1.00000000000000 
DL1¢1,2)=0.00000000000000 
DL1¢1,3)=0.00000000000000 
Dt1(2,1)=0.00000000000000 
Dt1(2,2)=1.00000000000000 
Balt2,3)=23E0P 
DL1C3,1)=DEFM 
Dt1(3,2)=SLOP 
Dt1(3,3)=1.00000000000000 
DL1DC1,12-0.00000000000000 
DL1D(1,2)=0.00000000000000 
DL1D(1,3)=0.00000000000000 


TS 


DL1D(2,1)=0.07000000000000 
DL1D(2,2)=0.0000000000000 
DL1D(2,3)=-SIDFED 
DL1D(3,1)=DEFMD 
DL1D(3,2)=SLOP 
DL1D(3,3)=0.00000000000000 
hele nl 
XIL(1,2)=0.00067141800000 
XIL(1,3)=.00000000000000 
XIL(2,1)=0.00067141800000 
XIL(2,2)=1.422D-06 
ХІ1(2,52:0.00000000000000 
XIL(3,1)=.00000000000000 
XIL(3,2)=0.00000000000000 
XIL(3,3)=5.97754D-04 
MX=.00067141800000 
XXI=1.422D-06 
YYI=5.97754D-04 

XIR(1,1)=MR 
XIR(1,2)=0.000000000000000 
XIR(1,3)=0.000000000000000 
XIR(2,1)=0.000000000000000 
XIR(2,2)=.027467130000000 
XIR(2,3)=0.000000000000000 
XIR(3,1)=0.000000000000000 
XIR(3,2)=0.000000000000000 
XIR(3,3)=.02746713000000 
ARTH(1,1)=0.00000000000000 
ARTH(1,2)=0.00000000000000 
ARTH(1,3)=0.00000000000000 
ARTH(2,1)=0.00000000000000 
ARTH(2,2)=-DSINCTH) 
ARTHC2, 3) =-DCOSCTH) 
ARTH(3,1)=0.00000000000000 
ARTHC3,2)=DCOSCTH) 
ARTH(3,3)=-DSINCTH) 
WRDDC1,1)=0.00000000000000 
WRDDC1,2)=0.00000000000000 
WRDDC1,3)=0.00000000000000 
WRDD(2,1)=-LLX¥DCOS( TH) XC THDXX2) 
WRDDC2,2)2-DCOSCTHOX(CTHDXx2) 
WRDDC2, 3») Z2DSINCTHO XCTHDXXx2) 
WRDDC3,1)=-LL¥DSINC TH) XC THDXX2 ) 
WRDDCS,2)2-DSINCTHOX(CTHDXXx2) 
WRDDC3,3)2-DCOSCTHO XCTHDXx2) 
ARRDD(1,1)=0.00000000000000 
ARRDD(1,2)=0.00000000000000 
ARRDD(1,3)=0.00000000000000 
ARRDD(2,1)=0.00000000000000 
ARRDD(2,2)=-DCOS( TH) XC THDXX2) 
ARRDD(2,3)=DSINC TH) XC THDXX2) 
ARRDD(3,1)=0.00000000000000 
ARRDDC 3,2) =-DSINC TH) XC THDXX2) 
ARRDDC3,3)z-DCOSCTHO XCTHDXX2) 


UC1,1)=DEFM 

UC 2,1) =SEUP 

UD(1,1)=DEFMD 
UD(2,1)=SLOPD 
1)=.37142360000000 


XMQQP(1,2)=-.05238100000000 
XMQQP(2,1)=-.05238100000000 
XMQQP(2,2)=.00952380000000 
G(1,1)=0.00000000000000 
6(2,12:0.00000000000000 
G(3,1)=-9.80660000000000 
H11(1,1)=4.35651900000000 
H11(1,2)=-2.42825869300000 
H11(1,3)=0.00000000000000 
H21(1,1)=0.00000000000000 
H21(1,2)=0.00000000000000 
H21(1,3)=AXMUXx( .50000000000000) 
H21(2,1)=0.00000000000000 
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ООО 


O O O 


O O O 


H21(2,2)=0.00000000000000 
H21(2,3)=AXMUX(-.08333333333333) 
DO 50 I=1,3 

DO 60 J=1,3 
DL11(1,J3)=0.00000000000000 
DL12(1,J3)=0.00000000000000 
CONTINUE 

CONTINUE 
DL11¢3,1)=1.00000000000000 
DL12¢2,3)=-1.00000000000000 
DL12(3,2)=1.00000000000000 
H61(1,1)>=ML 
H41C1,2)=0.000671418000000 
H61(1,3)=.000000000000000000 
XK11(1,1)=12.00000000000000XEXZI 
XxXK11(1,2)=-6.000000000000XEXZI 
XK11C2,122-6.000000000000XEXZI 
XxXK11(2,2)=4.0000000000000XEXZI 
RETURN 

END 


SUBROUTINE XLMMQQCMQQ,U,XMQQP,DL1,WITH,ARTH,XIL,XIR,A,MU,TH, DEFM, 
%5( ОР) 

REALX8 MQQ,UTC1,22,PC1,220,DL1TCS, 2), NTHTCS, 5), ARTHTCS, 35, P1C 5, 3) 
BERNER Р2(3,5),/Р5С3,5),Р4С5,3),Р5(5,3),Р6(5,5),Р7(5,3),М0) 
REALX8 UC2,10,XMQQPC2,22) , DL1C 5, 55, HTHCS, 2 , ARTHCS, 50, XILCS, 3) 
REALX8 XIRC3,30,A, TH, DEFM, SLOP,SP, TP 

Ш-2 

L=1 

N=3 

MQQ-0.00000000000000 

CALL TRANSCU,UT,M,L) 

CALL MATMULCUT,XMQQP,L,M,M,P) 

CALL MATMUL(P,U,L,M,L,SP) 

CALL TRANSCDL1,DL1T,N,N) 

CALL TRANSCARTH, ARTHT,N,ND 

CALL TRANSCHTH, HTHT,N, ND) 

CALL MATMULCHTH, DL1,N,N,N,PX) 

CALL MATMULCPI,XIL,N,N,N,P2) 

CALL MATMULCP2,DLIT,N,N,N,P3) 

CALL MATMULCPS,NTHT,N,N,N,P94) 

CALL MATMULCARTH, XIR,N,N,N,P5) 

CALL MATMULCPS, ARTHT,N,N,N,P6) 

CALL MATADDCPG,P6,N,N,P7) 

CALL TRACECP7,N), TP) 

MQQ=((1./3.)XAXMU) + CAXMUXSP) + TP 

RETURN 

END 


SUBROUTINE XLMMQNCXMQN,A,MU,ML,LL,MX,SLOP,DEFM, YYI,XXI) 
REALX8 XMQNC1,2),MU,ML,LL,MX,A,SLOP, DEFM, YYI,XXI 
XMQNC1L,1)=CAXMUXC .35000000000000) )+C(ML¥LL)+MX 
XMQNC1,2)=CAXMUXC-.05000000000000) )+CMX¥LLI+YYI+XXI 
SEDE RN 

ND 


SUBROUTINE ALMFQCFQ,U,XMQQP,DL1,WTH,ARTH,XIL,XIR,UD,H11,G,H21, 
E ee Е Оа ПЕГМЬЫРЕҒМО 50Р „аьдрр,А, мо, МС, 11, 
EE Mo) .PCI2)25PI1CI, 55), P2C1, 550, P3C1, 3D, P4C 5, 5),P5CS, 3D 
e S e PLZCSUISODPSC3, 39025 P9€C5, 35 , PIOCS, 3), P11C1,3D2,P12«€1, 
Reo "ЕРЕНСЗ,5),ЕН ПЕР SDESLDTCS, SD ÀNHDECS, 3),ARRDDEC 3 
REALX8 UT(1 ЛЛЕРЕС3 ЭЛУЕВЭС5, 5),NTHT Oa) 
REALX3 UC2, СЕЗ АРЕНС5, 5),ХІ((5,5) 

REALX8 XIR( 0D НОО? 5) S HRDDCS4S ) 
REALX8 DL1D 2,H4101,3),MU,LL,ML 


5 


TE 


) 
3) 


OOO 


ООО 


20 
10 


40 
50 


20 
10 


REALX8 A,TORQUE, FQ, TH, THD, DEFM, DEFMD,SLOP,SLOPD 
REAL*X8 ВЕР, ЭР; ТРУ ТЕРТЕР 

М=2 

L=1 

N=3 

CALL TRANSCU,UT,M,L) 

Do dong 2 

DO 20 J=1,2 
FQPCI,JO-XMQQPCI,JOXTHD 
CONTINUE 

CONTINUE 

CALL MATMULCUT,FQP,L,M, 
CALL MATMULCP,UD,L, M ,L, 
CALL TRANSCWTH,WTHT,N,N 
CALL MATMULCH11,HTHT,L, 
CALL MATMULCP1,G,L,N,L, 
CALL MATMULCUT,H21,L,M, 
CALL MATMULCP2, HTHT,L,N,N, 
CALL MATMULCPS, G,L, N,L, TP) 
CALL TRANSCDL1,DL1T,N,N) 
CALL TRANSCWRDD,WRDDT,N,N) 
CALL MATMULCWTH, DL1,N,N,N,P4) 
CALL MATMUL(P4,XIL,N,N,N,P5) 
CALL MATMULCP5,DL1T,N,N,N,P6) 
CALL MATMULCP6,WRDDT,N,N,N,FPF) 
CALL TRANSCDL1D,DLIDT,N, 

CALL TRANS(WD,WDT,N,N) 

CALL MATMUL (WTH,DL1,N, 

CALL MATMULCP7,XIL,N,N 

CALL MATMULCP8,DLIDT,N 
CALL MATMULCP9,WDT,N,N 
CALL TRANSCARRDD, ARRDD 
CALL MATMULCARTH,XIR,N 
CALL MATMULCP10,ARRDDT 
DO 30 I=1,3 

DO 40 J=1,3 ` 
FESCT,J) =FREIE 7 32 
CONTINUE 

CONTINUE 

CALL MATADD(CFPF.FPS,N,N,FPFH) 

CALL MATADDCFPFH,FPT,N,N,FHP) 

CALL TRACECFHP,N,TFP) 

CALL MATMULCHA41,DLIT,L,N,N,P11) 

CALL MATMULCPI1,NHTHT,L, N, N, P12) 

CALL MATMULCP12,G,L,N,L,FTHP) 

FQ=(=2, XAXMUXFP) + SP «ТР - ТЕР ТТГТНБИФИГОКИЕ 
RETURN 

END 


, 
N 
N 
T 


SUBROUTINE SMKNCXKN, XK11,XMQQP,A,MU, THD) 

REALX8 XKH(2,2),KNPC2,2) , XMQQPC2,2) , XK11( 2, 20, A, THD, MU 
DO 10 I=1,2 

DO 20 J=1,2 

KNPCT)J)=XMQQP CT, J)XC-A)XMUXCTHDAX2) 
XKNCI,JO-KNPCI,JO*XK11(CI, J) 

CONTINUE 

CONTINUE 

RETURN 

END 


SUBROUTINE SMMNQCXMNQ, DLI,WTH, XIL,DL11,DL12,WN,TH, DEFM,SLOP,A, IU) 
REALS ХИНО(2,12,11217С5,5),П111Т7(5,5)0,ИҒС5,5),РІС5,5),Р2 0) 
REALXS P3C5,5),P64C 5, 5), P5CS, 5), PGC 54,50 2 DEDOS 50 MTM CS, 50 AMO 
REALX8 WC5,52,DL11C3, 352), DL12C5, 5), TH, DEFM, SLOP,A, MU 

M=2 

L=1 

N=3 

CALL TRANS(DL11,DL11T,N,N) 
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OOO 


=) 


CALL 
CALL 
CALL 
CALL 
CALL 


TRANS(DL12,DL12T,N,N) 
TRANS(CW,NT,N,N) 
MATMULCHTH,DL1,N,N,N,P1) 
MATMULCPLI,XIL,N,N,N, P2) 
MATMULCP2,DLI1T,N,N,N,P3) 
MATMULCP3,WT,N,N,N,PG) 
TRACECP4,N,TFP1) 


XMNQ(1,1)=TFP1 + ((.35000000000000)XAXMU) 


CALL 
CALL 
CALL 


MATMULCP2,DLI2T,N,N,N,P5) 
MATMULCP5,WT,N,N,N,P6) 
TRACE(P6,N,TFP2) 


XMNQ(2,1)=TFP2 + (-.05000000000000XAXMU) 
RETURN 


END 


SUBROUTINE SMFNCFN,H21,W,G,WRDD,DL1,XIL,DL11,DL12, HD, DL1D, H61, TH, 


M=2 

L=1 

N=3 

CALL 
CALL 
CALL 
CALL 
CALL 
CALL 
CALL 
CALL 
CALL 
CALL 
CALL 
CALL 
CALL 
CALL 
CALL 
CALL 
CALL 


#THD, DEFM, DEFMD,SLOP,SLOPD) 
REAL X8 
REAL X8 
REAL X8 
REAL x8 
REAL x8 
REALX8 
REALx8 


BUS ОРОО ЛУ Р2(5,5›,Р5С5;5)0,;Р6С25,5),Р5(2$2,3),Р6(3,„3 
Ea ook 5, 5)76 90 375),61005,5)7F1105,5),P1203,3),P 
ЕЕС PISCIS, 3), PIGCI, 9) ПОЕ ТЕСЕ ЕРС2,10, 
FN1CS, 5), FN2C 5, 32, 6C 5, 12, H 2,3),WRDDC3,3),DL1D03,3 
WDC3,3),H41(1,3),XIL(3,3) , 3), DL11(3,3),DL12(3,3) 
BEBO 39 DELITCS, 5), DL12T ), 

TH, THD, DEFM, DEFMD,SLOP,SL 


Р1 
1( 
(3,5) 

PEN NETTES 
D 


TRANS(CW,WT,N,N) 
MATMULCH21,WT,M,N, 
MATMULCP1,G,M,N,L, 
TRANSCDLI1,DLIIT,N 
TRANSCDL12,DL12T,N 
MATMULCWRDD, DLI,N, 
MATMULCP2,XIL,N,N, 
MATMULCP3,DL11T,N, 
MATMULCHD,DLID,N,N,N, 
MATMULCP6,XIL,N,N,N,P7) 
MATMULCP7,DLI1T,N,N,N,P8) 
MATMULCPS8,HT,N,N,N,P9) 
MATMULCPS,DL12T,N,N,N,P10) 
MATMÚULCP10,WT,N,N,N,P11) 
MATMULCP7,DL12T,N,N,N,P12) 
MATMUL(P12,WT,N,N,N,P13) 


N,P 
ЕР) 
, N) 
‚N) 
N,N 
N,P 
N,N 
,P5 


DO 10 I=1,3 
DO 20 J=1,3 


рӘСІ, 


Ia OR LSA. 


БЕСІ, /2-РІЗСІ,./2Х<2. 
CONTINUE 
CONTINUE 


CALL 
CALL 
CALL 
CALL 


SP(1, 


MATADD(P5,P9,N,N,FN1) 
MATADDCP11,P13,N,N,FN2) 
TRACECFNI,N,TFNI) 
ТКАСЕСЕМ2,М,ТЕМ2) 
12-ТЕМ1 


SPC2,1)=TFN2 


CALL MATMUL (H41,DL11T,L,N,N,P14) 
CALL MATMUL(P14,WT,L,N,N,P15) 
CALL MATMUL(P15,G,L,N,L,FN3) 
CALL MATMULCHG1,DL12T,L,N,N,P16) 
CALL MATMULCP16,WT,L,N,N,PI17) 
CALL MATMUL(P17,G,L,N,L,FNG4) 
TPC1,1)=FN3 
TPC2,1)=FNG 

DO 31 I=1,2 
БИСИ Е ЕРСІ, 1) 
CONTINUE 

RETURN 

END 


aes LJP EP Cl) 


Te 


OOO 


OOO 


OOO 


OOO 


20 
10 


40 
30 


30 
10 


10 


SUBROUTINE SMMHNCXMNN, XMQQP,ML,A,MU, XXI, YYI,MX) 
REALX8 XMNN(2,2),XMQQPC2,22), ML, MU, A, XXI, YYI,MX 
DO 10 I-1,2 

DO 20 J=1,2 

XMNNCI,J2-0.00000000000000: 

CONTINUE 

CONTINUE 

XMHN(1,1)=ML 

XMNNC1,23=MX 

XMNNC2,1)=MX 

XMNN(2,2)=XXI+YYI 

DO 30 I=1,2 

DO 40 J=1,2 

XMNN(I,J)=XMNN(I,J) + XMQQPCI,J)*AXMU 

CONTINUE 

CONTINUE 

RETURN 

END 


MATRIX MULTIPLICATION SUBROUTINE 


SUBROUTINE MATMULCA,B,M,L,N,C) 
REALX8 ACM,LO,BCL,ND,CCM,ND 

DO 10 I=1,M 

DO 20 J=1,N 

C(I,J)=0.0 

DO 30 INDEX=1,L 

CCI,J)I=SCCI,J) + ACI, INDEX)XBCINDEX,J) 
CONTINUE 

CONTINUE 

CONTINUE 

RETURN 

END 


MATRIX TRANSPOSE SUBROUTINE 


SUBROUTINE TRANSCA, B, M,L) 
REALX8 ACM,L),BCL,M) 

DO 10 I=1,M 

DO 20 J=1,L 

BCJ, I2-ACI, J) 

CONTINUE ' 
CONTINUE 

RETURN 

END 


MATRIX TRACE SUBROUTINE 


SUBROUTINE TRACECA,M, TRAC) 
REALX8 ACM,M) 

TRAC=0.0 

DO 10 I=1,M 

ТКАС=ТКАС + АСІ,1) 
CONTINUE 

RETURN 

END 


MATRIX ADDITION SUBROUTINE 


SUBROUTINE MATADDCA,B,M,L,C) 
REAL¥8 ACM,L),BCM,L),CCM,L) 
Do 10 I=1,M 

DO 20 J=1,L 

CCI,J2-ACI,JÓ * B(I,J)D 
CONTINUE 

CONTINUE 

RETURN 

END 


80 


SUBROUTINE BIGFORCBIGM, BIGF,MQQ, XMQN, FQ, XMNQ, XMNN, XKN,FN,U) 
REAL%8 BIGM(3,3),BIGFC3,1),XMQNC1,2),XMNQC2,1),XMNNC2,23,XKNC2,2) 
REALX8 FNC2,12,UC2, 12, MQQ, PC2, 12), FQ 


M=2 

ізі 

ВІСМ(1,12:М00 
BIGMC1,2)-2XMQNCI,1) 
BIGMC1,3)=XMQNC1, 2) 
BIGMC2,12-2XMNQC1,1) 
BIGMC2,2)=XMNNC1,1) 
ВІСМ(2, 35) = ХМММС1, 2) 
BIGMC3,12-XMNQC2, 1) 
BIGMC3,2)-2XMHNC2, 1) 
BIGMC3,3)-2XMNNC2,2) 
BIGF(1,1)=FQ 

CALL MATMULCXKN,U,M,M,L,P) 
BIGF(2,1)=FNC(1,1)-P(1,1) 
BIGF(3,1)=FN(2,1)-P(2,1) 
RETURN 

END 


990 


SUBROUTINE XLEQ(BIGM,BIGF,SOL) 
REALX8 BIGM(3,3),BIGF(3,1),SOLC3),WKAREA(13) 


M=1 

N=3 

CALL LEQT2F CBIGM,M,N, N, BIGF,M, HKAREA, IER) 
DO 10 I=1,3 


SOL(I)=BIGF(I,1) 
10 CONTINUE 

RETURN 

END 


OOO 


SUBROUTINE GLOBCGPOS,W, DEFM) 
REAL¥8 GPOS(3),WC3,3),DEFM,RLC3) 
RLCI2-1.0D0 

RLC227-0.0D0 

3) ZDEFM 


% 


ENDJOB 
/X 


Zu 
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APPENDTS Е 
DERIVATION OF THE SHAPE FUNCTION MATRIX 
AND THE NODAL DISPLACEMENT VECTOR 
A cubic shape function is assumed to represent the 
transverse displacement of the single link flexible arm 


as follows, 


V - ag * a, x + a, х? + a x? - displacement (C. 19 


ф = a4 + 2. a, X + 3. a, x? - Slope (C. 


The boundary conditions of zero displacement and slope 
at the base where x is equal to minus the link length, L, 
is invoked. This is in accordance with the positive sign 
convention of the local coordinate system. 

Substituting the boundary conditions into the. shape 


functions gives, 


E 2 - 
v(-L) = au = a] L + a, L -= a, L = 0 (C. ay 

A s qa 
ó(-L) = a1 2 a, INE 352 a4 ш = 0 (COEM 
v(0) = a, (С 327 
ф(0) = ay (CON 
Substituting (C.5) and (C.6) into (С.3) ана (С.А) Ша 

solving the two equations for a2 and a3 gives: 
9 

a) = (2. 910) L 3900 ЕЕ (CE 
a, = ($(0) L - 2. v(0))/L? (с.8) 
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ENS EG 5) 20925) (C.7), (C.8) into (C.1) and 
collecting terms gives an expression for the transverse 


displacement along the arm length as a function of the arm 


tip nodal displacements, v(0) and %(0), 
SELLE Mir. -—(- x35) v(0) + (x + 
(ee) Ja + (x3»752) $0) (C.9) 


Substituting v(x) into the 3xl deformation vector 
results in a 3x2 shape function matrix and a 2x1 nodal 


displacement vector as follows, 


o : ] 


D- (0,0,vG9)T - ' (v(0),6(0))7 
| | 
| 2 3 2 3 
! o 2х 2х x 
(1 — — - —) (x + — + ) 
| 1,2 1? р, 1,2 
(C 510) 


Since the expression v'' is necessary for determining 
the potential energy due to deformation, the shape function 
Ing Es rrerentiated twice and results in the following 


modified shape function matrix. 


= = 
0 0 
T 
(0,0,v'') 0 0 (v(0),0(0)) 
6 12x 4 6X 
( - — - —) DL (C.11) 
2 ae L m 


The theoretical strain is computed from the expression 
for v'' obtained from the modified shape function matrix. 
Assuming simple beam theory, v'' is approximated to equal 
the curvature, and since curvature is related to strain, the 


following expression is obtained for the strain: 


Sa ero. yr (C. 1 


Em is the strain at the maximum distance from the 
neutral axis 


Ci is the maximum distance from the neutral axis 
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APPENDIX D 
INE EP LON, slate SPACE REPRESENTATION, 
AND OPTIMAL CONTROLLER DESIGN 
OF SINGLE-LINK DYNAMIC EQUATIONS (ERLS) 

The equations of motion for the single-link flexible arm 
were defined as follows: 

MQQ 6 + MQN U = F (D.1) 

MNQ 6 + MNN U + KN U = FN [ко 

The linearized operating point is defined as follows: 

U= 0.0 Ө = 0.0 | (D.3) 

T= 0,0 2-00 

пешо 8 S Oot 

Taking the differential of each coefficient and term in 
the equations of motion and evaluating them at the operating 
point gives the following two linearized equations of motion. 

F, 0 + F. U = T (D.4) 

B. 0 4 Р, U Ps U = 0.0 (D. 5) 

where the coefficients are the linearized complements of 
the non-linear coefficients as follows: 

Fi is from MQQ, F is from MON, and T is the applied 
Eee 

Ғ. is from MNO, E, is from MNN, and F. is from KN. 


3 з 2 


The state space variables are defined as follows: 


E u 
X, = у X4 = Фф (D.6) 
косу хб = ф 
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variable description, 


Utilizing equations (D.3) threuga Des лл 


the following 6х6 matrix equation 


іс formed: 








| r1 Г 7 7 E 
[o F F, 0 ° i 00020 0 0| Е 1 
| 1x2 EE | m 
| Lem 0 0 0 а ZO 
[vo Жа E x= [9.0.0 0 2x2 х. |+ |, От 
2х1 2х2 a | | | 
i | *4 | 
1 0 AO AT 0 | | (0. ITEM M 0 0 O | 
ze | =p 
0 0 060 1 0 ! Qu. 0 w 0 0 0 
= | | ке 
T 
0 0 O O O O OTTONE TEER u | N 
M F Т. 
(DN 
Equation (D.7) is then put into standard state space 
format, 
X=A X +B Uu (D.8) 
1 ES 
where  A-M Ғ апа В-М Ту. 


The output equation having C as the identity matrix is, 


= C 


у X 


Using the mainframe computer CONTROLS program OPTSYS, an 


optimal controller for the linearized equations of motion is 


designed and the optimal feedback gain control matrix, Gc, 


ls determined. 


the 


The closed loop feedback control system for 


linearized plant is as follows: 
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КЕЕ ЕВИ АКЕ X—-ACTUAL 
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